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Vehicle Position Detector Device and Its Processing Method 

FIELD OF THE INVENTION 

The present invention relates to a detector device for confirming the moving 
5 vehicle position and method for obtaining the vehicle position information. 

BACKGROUND OF THE INVENTION 

The Global Position System (GPS) which are widely used at present for the 
navigating and positioning of aviation, space flight, voyage and ground carrier may 

10 provide the positioning and navigating of all weather and continuous three 
dimension in all the world. However, in case of vehicle entering into tunnel, going 
under elevated highway or into urban center ways that are surrounded by high 
buildings, the GPS may no longer works normally for reasons of GPS receiver 
antenna being blocked or the signal being interfered. For resolving this problem, a 

15 method of calculating current position to compensate GPS signal missing by 
azimuth sensor and velocity sensor is proposed in the Chinese Invention Patent 
ZL971 10539.1. The most used azimuth sensor in navigation system at present is 
the Inertia Navigation System (INS), such as gyroscope, in which the carrier 
angular velocity and acceleration measured by inertia measuring unit (IMU) are 

20 calculated and exchanged to obtain navigation information. The core unit of the 
Inertia Navigation System is a fast running gyro that has not only a poor 
anti-vibration performance but also a high manufacture cost. Therefore, the Inertia 
Navigation System is mainly applied in large carrier means such as the carrier 
rocket, airplane and ship etc and some super cars at present, hardly popularized in 

25 civil cars. 

According to physical principle, a car moving on ground may be seen as a 
plane moving rigid body. Refer to Fig.l, taking the wheel center points L and R at 
two vehicle sides as reference points, on any a moment, the vehicle movement may 
be broken up as a composition of parallel movement along the reference point R 
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and a turning movement around the reference point R. The turning line velocity of 
reference point L relative to reference point R on vehicle equals about the two 
sides velocity difference AV=V L — V R , the angular velocity of reference point L 
turning around reference point R is co^AV/1, in which, 1 is the distance between 
5 point L and point R, that is the spacing between left and right wheels of the vehicle. 
In this way, the vehicle moving track may be calculated by the kinematics rule only 
if the vehicle position and direction at preceding moment have been known and the 
moving velocities V L and V R of points L and R have been measured. 

10 CONTENTS OF THE INVENTION 

The present invention provides a vehicle position detector device that obtains 
the vehicle position information at lower cost and a method in which the moving 
vehicle current position could be confirmed in case of GPS signal being interfered 
or missed. 

15 The vehicle position detector device provided by the present invention 

comprises: 

A GPS module for receiving and processing the GPS satellite signal, used to 
receive the satellite position information: 

Two groups of velocity sensor elements, for sensing the moving velocity of 
20 left and right side wheels or other moving mechanism of the vehicle; 

A calculation unit, for calculating the moving velocity, direction and position 
coordinate of the vehicle, comparing the GPS position information with calculation 
results, eliminating the invalid data and providing the correct and effective vehicle 
position information; 

25 A communication interface, for transmitting the vehicle position information 

processed by calculation unit to the position information display device or vehicle 
navigation system. 

The method of confirming the moving vehicle current position according to 
the present invention is realized through the following steps: 

2 
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1 . Sensing respectively the moving velocity of both side wheels or other 
moving mechanism by the velocity sensor elements mounted on the left 
and right side of the vehicle, and calculating the vehicle moving velocity 
and the azimuth angle variation in moving direction according to the 

5 velocity measured by the velocity sensor; 

2. Taking the vehicle position coordinate and azimuth at the preceding 
moment as the reference position information to calculate the vehicle 
current position coordinate and azimuth with the calculation result of step 

i; 

10 3. Receiving the GPS position information, comparing the position data 

obtained from the GPS measurement with the calculation result of step 2, 
eliminating the invalid data caused by the blocked or interfered GPS signal, 
eliminating the accumulated error of the calculation result of step 2, 
thereby obtaining the correct and effective vehicle position information. 

15 

BRIEF DESCIPTION OF THE APPENDED DRAWINGS 

Fig.l is a principle sketch map of the present invention. 

Fig.2 is a circuit block diagram showing an embodiment of the vehicle 
position detector device according to the present invention. 
20 Fig.3 is a sketch map showing the sensor layout of the vehicle position 

detector device according to the present invention. 

Fig.4 is a processing flowchart showing the obtaining method of the vehicle 
position information according to the present invention. 

Fig.5 is a sketch map showing the vehicle moving track. 

25 

DESCRIPTION OF THE EMBODIMENTS 

The embodiment according to the present invention will be described with 
reference to the drawings. 

An embodiment of the vehicle position detector device according to the 
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present invention comprises the following parts, refer to Fig.2: 

A GPS module 1 for receiving and processing the GPS satellite signal, used to 
receive and provide the satellite position information. The GPS module 1 may be 
an universal GPS position module, e.g. the series GPS 15 or GPS 25 from 
5 GARMIN Co. 

A left side velocity sensor element 2 and a right side velocity sensor element 
3 , they are mounted on the vehicle left and right side respectively, for sensing the 
moving velocity of the left and right wheels or other moving mechanism of the 
vehicle. The velocity sensor element 2 and 3 may be an universal velocity sensor 

10 element, such as electromagnet coil, photoelectric sensor or some magnetic sensor 
element. The simplest sensor element may be a reed tube, and the even reliable 
sensor element may be a Hall element or contactless sensor element such as 
magnetic-sensitive resistor. 

Calculation unit 4, for calculating the vehicle moving velocity, direction and 

15 position coordinate, comparing the GPS position information with calculation 
results, eliminating the invalid data and providing the correct and effective vehicle 
position information. The calculation unit 4 may be an universal single chip 
microprocessor, such as the 89C51 or 89C52 chip of series MCS-51. The GPS 
module 1 is connected to the data receiving input terminal RXD of serial 

20 communication interface of the calculation unit 4. The velocity sensor element 2 
and 3 are connected to the input ports of the calculation unit 4, e.g. some input 
terminals in the P3 port or PI port of series MCS-5 1 . 

Communication interface 5, for transmitting the vehicle position information 
processed by calculation unit to the position information display device or vehicle 

25 navigation system. The communication interface 5 may employ the data 
transmission output terminal TXD of serial communication interface of the 
calculation unit 4. For convenience of the computer connection with the vehicle 
navigation system, the RS232 standard may be adopted for the serial 
communication port, and the universal MAX232 level changeover chip may be 
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employed to realize the level changeover. 

Each group of velocity sensor element 2 or 3 in the vehicle position detector 
device according to present invention comprises at lest a sensitive element fixed 
onto the vehicle and an inductive point element fixed onto the wheel. Fig.3 is an 
5 illustration showing a concrete layout of the velocity sensor element according to 
the present invention. The inductive point element 7 in this layout is a permanent 
magnet that is fixed onto the wheel inner side and opposite to the sensitive element, 
eight inductive point elements are evenly mounted on the inner side of left and 
right wheel 6, and on the circle of the position relative to the magnetic sensitive 

10 element 2 or 3. According to the embodiment, each velocity sensor element could 
obtain eight count pulses whenever the wheel turning a circle, and the 
measurement precision is heightened without increasing cost. 

According to the embodiment, each sensitive element 2 and 3 comprises two 
sensitive elements that are fixed onto the vehicle two sides, nearby the left and 

15 right wheel 6 and opposite to the inductive point element 7. The wheel turning 
direction could be judged by sensing the phase difference between the count pulses 
produced by two sensitive elements in the same group. Owing to the fact that the 
wheels on both vehicle sides are normally turning in the same direction, in an even 
simpler embodiment, two sensitive elements are configured in only one side of the 

20 sensitive element 2 or 3. 

The calculation unit 4 of the vehicle position detector device according to the 
present invention may also be combined into the GPS module 1, co-uses a same 
calculation unit with the GPS satellite signal processing unit, and a modularized 
vehicle position detector device is thus formed. 

25 The method of confirming the moving vehicle current position according to 

the present invention comprises the concrete steps shown in Fig.4, the vehicle 
position method according to the present invention will be described in details with 
reference to the Fig.l, Fig.4 and Fig.5: 

1. Sensing respectively the moving velocity V L and V R of both side wheels of 
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the vehicle by use of the velocity sensitive element 2 and 3 mounted on the left and 
right side of the vehicle, calculating the average velocity V t =(V L +V R )/2 of the 
vehicle t moment, calculating the variational angular velocity o> of azimuth angle 
in the moving direction; 
5 2. Taking the geography coordinate and azimuth angle 8 0 at vehicle to moment 

and P 0 position as the reference position information, by use of the integration of 
average velocity V and angular velocity co relative to time, calculating the 
geography coordinate P at vehicle t moment, azimuth angle variation A0= £dt, 
and calculating the azimuth angle 0=0 A +A6 in the moving direction when the 

1 0 vehicle approaching the position P; 

3. Receiving the navigation satellite signal by use of the GPS module 1, if the 
GPS satellite signal is valid, employ the GPS position data to obtain the geography 
coordinate, azimuth angle 6 G in the moving direction and vehicle moving velocity 
V G at vehicle t moment and P G position; 

15 4. Comparing the vehicle moving velocity V G obtained by the GPS module 

with the average velocity V t actually measured in step 1, if the error is no more 
than the tolerance, take the satellite position data P G , 6 G and the actual measured 
average velocity V t as the basic position information at vehicle t moment, and 
eliminate the accumulated error of the calculation result in step 2; 

20 5. If the V G and V t comparison error is beyond the tolerance, it could be 

judged that the GPS is being interfered, and the received data is an invalid data, or, 
if the GPS module 1 could not receive the valid satellite signal, the data P and 6 
calculated in step 2 and the actual measured average velocity V t may be taken as 
the basic position information at vehicle t moment, and eliminate the invalid data 

25 caused by the blocked or interfered GPS signal; 

6. The basic position information obtained in step 4 or step 5 is transmitted 
via the communication interface to the position information display device or the 
vehicle navigation system, and stored as the new reference position information at 
the same time; 
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7. Repeating the process of step 1 to step 6 to eliminate the invalid data 
caused by the blocked or interfered GPS signal, eliminate the accumulated error in 
the calculation result when calculating the position according to velocity and 
direction, and the reliable and effective vehicle position information may be 
5 obtained continuously. 

It can be seen from the above, the vehicle position detector device and 
method according to the present invention replace the complicated and expensive 
inertia measurement device with the low cost and high reliability velocity sensor 
element, it could compensate the drawback of GPS signal of being apt to be 

10 interfered in pure GPS vehicle navigation system with lowest cost, it could 
measure the moving vehicle position with precision when the GPS signal is 
interfered or missed. In the ABS technology which is widely employed in the new 
vehicle braking system at present and in which the braking process is controlled by 
the wheel velocity, each wheel must be equipped with a velocity sensor element to 

15 measure the wheel velocity, thus, if the vehicle position detector device according 
to the present invention and ABS braking system co-use a same velocity sensor 
element, the present invention technology could be realized without increasing any 
cost, and the merit of the present invention could be even more obviously and 
highly lighted. 
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